العودة للمكتبة التعليمية

أكمال Function Block للتحكم في الحركة

أوامر السرعة والتموضع - MC_MoveVelocity، MC_MoveRelative، MC_MoveAbsolute

إعداد: فريق CNCCO للتحكم الصناعي

Motion Control FB | UDT | Data Organization

إضافة أوامر الحركة التلقائية

تم دمج الثلاث وظائف الأكثر استخداماً في البرمجة الآلية:

MC_MoveVelocity
  • لتشغيل المحور بسرعة ثابتة (التحكم في السرعة)
  • يظل المحور يدور حتى يتلقى أمر إيقاف
  • يستخدم في تطبيقات النقل المستمر (Conveyors, Fans)
MC_MoveRelative
  • لتحريك المحور مسافة محددة من مكانه الحالي (التحكم النسبي)
  • الموقع المستهدف = الموقع الحالي + المسافة المحددة
  • مفيد في تطبيقات التغذية (Feeding) والنقل المتقطع
MC_MoveAbsolute
  • لتحريك المحور إلى إحداثي محدد بدقة (التحكم المطلق)
  • تنبيه: يجب التأكد من عمل "Homing" صحيح قبل استخدام هذا الأمر
  • لتجنب الاصطدامات (Crash) يجب ضبط Software Limits
⚠️ تنبيه: قبل استخدام MC_MoveAbsolute، تأكد من:
  • تنفيذ Homing (ضبط نقطة الصفر)
  • ضبط Software Limits بشكل صحيح
  • معرفة الموقع الحالي للمحور

الفرق بين MC_Halt و MC_Stop

MC_Halt
  • إيقاف مؤقت للمحور (Trigger)
  • بمجرد توقف المحور، يمكن تنفيذ أمر حركة جديد فوراً
  • يستخدم للتوقف المؤقت (مثل انتظار إشارة)
  • لا يمنع أوامر الحركة المستقبلية
MC_Stop
  • إيقاف تام ومنع حركة (Active Signal)
  • طالما أن هذه الإشارة مفعلة، لن يقبل المحور أي أمر حركة جديد من أي بلوك آخر
  • يُستخدم عادةً في مناطق التداخل (Interlock) مع الروبوتات أو أجزاء الماكينة الأخرى
  • يتطلب إشارة منفصلة لإعادة التمكين (Re-enable)

استخدام MC_Stop في مناطق التداخل

Robot Arm Moving
→
Conveyor Stop (MC_Stop)
→
Safe Zone
// MC_Halt - إيقاف مؤقت
MC_Halt_Instance(
    Axis := Axis_TO,
    Execute := Halt_Cmd,
    Done => Halt_Done
);

// MC_Stop - إيقاف تام مع منع الحركة
MC_Stop_Instance(
    Axis := Axis_TO,
    Execute := Stop_Cmd,
    Done => Stop_Done
);

// ملاحظة: MC_Stop يبقى فعالاً طالما Execute = TRUE

استرجاع البيانات الفورية (Feedback)

تمت إضافة أوامر `Move` داخل الـ FB لاستخراج البيانات التالية من الـ Technology Object:

البيانات المستخرجة
  • السرعة الفعلية للمحرك (Actual Speed) - RPM الفعلية
  • سرعة المحور (Actual Velocity) - سرعة المحور بوحدة المستخدم (مم/ث، درجة/ث)
  • الموقع الفعلي (Actual Position) - الموضع الحالي للمحور
  • إشارة الثبات (Standstill) - لمعرفة ما إذا كان المحور متوقفاً تماماً
// استرجاع البيانات من Technology Object
Actual_Speed := Axis_TO.ActualSpeed;        // RPM
Actual_Velocity := Axis_TO.ActualVelocity;  // وحدة المستخدم/ث
Actual_Position := Axis_TO.ActualPosition;  // وحدة المستخدم
Standstill := Axis_TO.StatusWord.X2;        // إشارة الثبات

أهمية إشارة Standstill

إشارة Standstill تخبرك ما إذا كان المحور متوقفاً تماماً. هذا مفيد جداً لضمان سلامة العمليات التالية (مثل فتح قفل الأمان، بدء عملية جديدة).

تنظيم البيانات باستخدام الـ UDT

ما هو UDT؟

UDT (User Defined Data Type) هو نوع بيانات مخصص يحتوي على جميع المتغيرات (Inputs/Outputs/Setpoints) الخاصة بالمحور.

// UDT_AxisData Structure
TYPE UDT_AxisData :
STRUCT
    // Inputs
    Enable : Bool;
    Reset_Cmd : Bool;
    Home_Cmd : Bool;
    Velocity_Cmd : Bool;
    Velocity_Setpoint : Real;
    Relative_Cmd : Bool;
    Relative_Distance : Real;
    Absolute_Cmd : Bool;
    Absolute_Position : Real;
    Halt_Cmd : Bool;
    Stop_Cmd : Bool;
    Jog_Forward : Bool;
    Jog_Backward : Bool;
    
    // Outputs
    Axis_Ready : Bool;
    Error : Bool;
    Actual_Position : Real;
    Actual_Velocity : Real;
    Standstill : Bool;
    
    // Setpoints
    Jog_Velocity : Real;
    Acceleration : Real;
    Deceleration : Real;
END_STRUCT
END_TYPE
ميزات استخدام UDT
  • إضافة محور جديد (مثل Conveyor 2) بمجرد إضافة سطر واحد فقط في الـ DB
  • تنظيم أفضل للبيانات وسهولة الصيانة
  • ربط سهل مع شاشات HMI
  • قابلية عالية لإعادة الاستخدام
// إنشاء Data Block باستخدام UDT
DATA_BLOCK DB_Axes
    // Array of Axis Data
    Axis_1 : UDT_AxisData;
    Axis_2 : UDT_AxisData;
    Axis_3 : UDT_AxisData;
END_DATA_BLOCK

// استدعاء FB لكل محور
FB_Positioning_Axis(
    Axis_TO := TO_Axis_1,
    Axis_Data := DB_Axes.Axis_1
);

فلسفة العمل (Done & Busy Signals)

أهمية إشارة Done

أكد الفيديو على أهمية مراقبة إشارة Done؛ حيث لا يجب إرسال أمر الحركة التالي إلا بعد التأكد من اكتمال المهمة الحالية.

أمر الحركة 1
→
انتظر Done = TRUE
→
أمر الحركة 2
مثال: تسلسل آمن
// State Machine with Done signal
CASE State OF
    0: // Idle
        IF Start_Cmd THEN
            MC_MoveAbsolute_Instance(
                Axis := Axis_TO,
                Execute := TRUE,
                Position := 100.0,
                Done => Move1_Done
            );
            State := 10;
        END_IF;
        
    10: // Wait for completion
        IF Move1_Done THEN
            MC_MoveAbsolute_Instance(
                Axis := Axis_TO,
                Execute := TRUE,
                Position := 200.0,
                Done => Move2_Done
            );
            State := 20;
        END_IF;
        
    20: // Wait for second completion
        IF Move2_Done THEN
            State := 0;
        END_IF;
END_CASE;

قاعدة ذهبية

لا ترسل أمر الحركة التالي قبل التأكد من اكتمال الأمر الحالي (Done = TRUE). هذا يضمن تسلسلاً برمجياً (Sequence) آمناً ومستقراً.

الكود الكامل لـ FB

// FB_Positioning_Axis - Complete Motion Control Function Block
FUNCTION_BLOCK FB_Positioning_Axis
VAR_IN_OUT
    Axis_TO : TO_PositioningAxis;
    Axis_Data : UDT_AxisData;
END_VAR

VAR
    // Motion Control Instances (Multi-Instance)
    MC_Reset_Instance : MC_Reset;
    MC_Power_Instance : MC_Power;
    MC_Home_Instance : MC_Home;
    MC_MoveVelocity_Instance : MC_MoveVelocity;
    MC_MoveRelative_Instance : MC_MoveRelative;
    MC_MoveAbsolute_Instance : MC_MoveAbsolute;
    MC_Halt_Instance : MC_Halt;
    MC_Stop_Instance : MC_Stop;
    MC_MoveJog_Instance : MC_MoveJog;
    
    // Internal variables
    Access_Ready : Bool;
    Home_Done : Bool;
    Velocity_Done : Bool;
    Relative_Done : Bool;
    Absolute_Done : Bool;
END_VAR

// ========== 1. MC_Reset ==========
MC_Reset_Instance(
    Axis := Axis_TO,
    Execute := Axis_Data.Reset_Cmd
);

// ========== 2. MC_Power with Access Ready ==========
IF Axis_TO.StatusWord.X0 AND Axis_TO.StatusWord.X1 THEN
    Access_Ready := TRUE;
END_IF;

MC_Power_Instance(
    Axis := Axis_TO,
    Enable := Axis_Data.Enable AND Access_Ready,
    Status => Axis_Data.Axis_Ready,
    Error => Axis_Data.Error
);

// ========== 3. MC_Home ==========
MC_Home_Instance(
    Axis := Axis_TO,
    Execute := Axis_Data.Home_Cmd AND Axis_Data.Axis_Ready,
    Position := 0.0,
    Mode := 0,
    Done => Home_Done
);

// ========== 4. MC_MoveVelocity ==========
MC_MoveVelocity_Instance(
    Axis := Axis_TO,
    Execute := Axis_Data.Velocity_Cmd,
    Velocity := Axis_Data.Velocity_Setpoint,
    Acceleration := -1.0,
    Deceleration := -1.0,
    Done => Velocity_Done
);

// ========== 5. MC_MoveRelative ==========
MC_MoveRelative_Instance(
    Axis := Axis_TO,
    Execute := Axis_Data.Relative_Cmd,
    Distance := Axis_Data.Relative_Distance,
    Velocity := Axis_Data.Velocity_Setpoint,
    Acceleration := -1.0,
    Deceleration := -1.0,
    Done => Relative_Done
);

// ========== 6. MC_MoveAbsolute ==========
MC_MoveAbsolute_Instance(
    Axis := Axis_TO,
    Execute := Axis_Data.Absolute_Cmd,
    Position := Axis_Data.Absolute_Position,
    Velocity := Axis_Data.Velocity_Setpoint,
    Acceleration := -1.0,
    Deceleration := -1.0,
    Done => Absolute_Done
);

// ========== 7. MC_Halt ==========
MC_Halt_Instance(
    Axis := Axis_TO,
    Execute := Axis_Data.Halt_Cmd
);

// ========== 8. MC_Stop ==========
MC_Stop_Instance(
    Axis := Axis_TO,
    Execute := Axis_Data.Stop_Cmd
);

// ========== 9. MC_Jog ==========
MC_MoveJog_Instance(
    Axis := Axis_TO,
    JogForward := Axis_Data.Jog_Forward,
    JogBackward := Axis_Data.Jog_Backward,
    Velocity := Axis_Data.Jog_Velocity,
    Acceleration := Axis_Data.Acceleration,
    Deceleration := Axis_Data.Deceleration
);

// ========== 10. Feedback Data ==========
Axis_Data.Actual_Speed := Axis_TO.ActualSpeed;
Axis_Data.Actual_Velocity := Axis_TO.ActualVelocity;
Axis_Data.Actual_Position := Axis_TO.ActualPosition;
Axis_Data.Standstill := Axis_TO.StatusWord.X2;
العودة إلى المكتبة التعليمية الرئيسية